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CLAIMS 

1. A control device for a mobile body that comprises a 
desired gait determining means for determining a desired 
gait composed of a desired motion and a desired floor 
5 reaction force of a mobile body, such as a mobile robot 
having three or more ground contact portions connected 
through the intermediary of a plurality of joints such 
that mutual relative heights thereof can be manipulated, 
and a floor reaction force detecting means for detecting 

10 or estimating an actual floor reaction force acting on 

each of the ground contact portions, and controls the 
operation of the mobile body to make a gait of the mobile 
body follow a desired gait, 

wherein the ground contact portions are classified 

15 into a tree structure such that each of the ground contact 
portions becomes a leaf node, and an intermediate node 
exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to a B-th node, which is each node in the 

20 tree structure, if the B-th node is the leaf node, then a 
floor reaction force acting on a ground contact portion 
that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if the B-th node has 
child nodes, then the resultant force of the node floor 

25 reaction forces of all child nodes of the B-th node is 

defined as the node floor reaction force of the B-th node, 
the control device for a mobile body, comprising: 
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a means for determining an actual node floor 
reaction force as the actual value of the node floor 
reaction force of each node from the detected or estimated 
actual floor reaction force of each ground contact 
5 portion; 

a means for determining a desired node floor 
reaction force as the desired value of a node floor 
reaction force of each node on the basis of at least a 
desired floor reaction force of the desired gait; and 

10 a node operation controlling means that determines, 

on each of C-th nodes, which is a node having a plurality 
of ground contact portions as descendant nodes, the 
correction amounts of the desired relative heights of a 
plurality of ground contact portions belonging to the C-th 

15 node on the basis of at least the relative relationship 

among the actual node floor reaction forces of each child 
node of the C-th node and the relative relationship among 
the desired node floor reaction forces of each child node 
of the C-th node, determines a corrected desired motion by 

20 adding at least a first correction of the desired relative 
heights of the plurality of ground contact portions 
belonging to each C-th node to a desired motion of the 
desired gait on the basis of a correction amount obtained 
by combining the determined correction amounts of all C-th 

25 nodes, and operates the joints such that the corrected 
desired motion that has been determined is satisfied. 
2. A control device for a mobile body that comprises a 
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desired gait determining means for determining a desired 
gait composed of a desired motion and a desired floor 
reaction force of a mobile body, such as a mobile robot 
having three or more ground contact portions connected 
5 through the intermediary of a plurality of joints such 

that mutual relative heights thereof can be manipulated, 
and a floor reaction force detecting means for detecting 
or estimating an actual floor reaction force acting on 
each of the ground contact portions, and controls the 

10 operation of the mobile body to make a gait of the mobile 

body follow a desired gait, 

wherein the ground contact portions are classified 
into a tree structure such that each of the ground contact 
portions becomes a leaf node, and an intermediate node 

15 exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to each of B-th nodes, which is each node 
in the tree structure, if the B-th node is the leaf node, 
then a floor reaction force acting on a ground contact 

20 portion that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if an A-th node has 
child nodes, then the resultant force of the node floor 
reaction forces of all child nodes of the B-th node is 
defined as the node floor reaction force of the B-th node, 

25 the control device for a mobile body, comprising: 

relative to a predetermined C-th node that is an 
intermediate node having a plurality of ground contact 
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portions as descendant nodes, 

a means for determining an actual node floor 
reaction force as the actual value of a node floor 
reaction force of each child node of at least the C-th 
5 node from the detected or estimated actual floor reaction 
force of each ground contact portion; 

a means for determining a desired node floor 
reaction force as the desired value of a node floor 
reaction force of each child node of at least the C-th 

10 node on the basis of at least a desired floor reaction 
force of the desired gait; and 

a node operation controlling means that determines a 
corrected desired motion by adding at least a first 
correction of the desired relative heights of the 

15 plurality of ground contact portions belonging to the C-th 
node to the desired motion of the desired gait on the 
basis of at least a relative relationship among the actual 
node floor reaction forces of each child node of the C-th 
node and a relative relationship among the desired node 

20 floor reaction forces of each child node of the C-th node 
such that the relative relationship among the actual node 
floor reaction forces of the child nodes of the C-th node 
approximates the relative relationship among the desired 
node floor reaction forces of each child node of the C-th 

25 node, and operates the joints such that the corrected 
desired motion that has been determined is satisfied. 
3. The control device for a mobile body according to 
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Claim 1, wherein 

a weight has been set on each node in the tree 
structure, and relative to a B-th node, which is each node 
in the tree structure, if the B-th node is the leaf node, 
5 then the height of a ground contact portion that is the 
leaf node is defined as the height of the B-th node, and 
if the B-th node has child nodes, then a weighted mean 
value, which uses the weight, of the heights of all child 
nodes of the B-th node is defined as the height of the B- 

10 th node, and 

if the node operation controlling means determines 
the corrected desired motion for only one arbitrary node 
among the C-th nodes by adding a first correction of the 
desired relative heights of a plurality of ground contact 

15 portions belonging to that one node to a desired motion of 
the desired gait, then a desired height of that one node 
in the corrected desired motion is maintained at a desired 
height in the desired motion. 

4. The control device for a mobile body according to 

20 Claim 2, wherein 

a weight has been set on each node in the tree 
structure, and relative the B-th node, which is each node 
in the tree structure, and if the B-th node is a leaf node, 
then the height of a ground contact portion that is the 

25 leaf node is defined as the height of the B-th node, and 
if the B-th node has child nodes, then the weighted mean 
value, which uses said weight, of the heights of all child 
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nodes of the B-th node is defined as the height of the B- 
th node, and 

if the node operation controlling means determines, 
only on the C-th node, the corrected desired motion by 
5 adding a first correction of the desired relative heights 
of a plurality of ground contact portions belonging to the 
C-th node to the desired motion, then the desired height 
of the C-th node in the corrected desired motion is 
maintained at a desired height in the desired motion. 

10 5. A control device for a mobile body that comprises a 

desired gait determining means for determining a desired 
gait composed of a desired motion and a desired floor 
reaction force of a mobile body, such as a mobile robot 
having three or more ground contact portions connected 

15 through the intermediary of a plurality of joints such 

that mutual relative heights thereof can be manipulated, 
and a floor reaction force detecting means for detecting 
or estimating an actual floor reaction force acting on 
each of the ground contact portions, and controls the 

20 operation of the mobile body to make a gait of the mobile 
body follow a desired gait, 

wherein the ground contact portions are classified 
into a tree structure such that each of the ground contact 
portions becomes a leaf node, and an intermediate node 

25 exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to a B-th node, which is each node in the 
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tree structure, if the B-th node is the leaf node, then a 
floor reaction force acting on a ground contact portion 
that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if the B-th node has 
child nodes, then the resultant force of the node floor 
reaction forces of all child nodes of the B-th node is 
defined as the node floor reaction force of the B-th node, 
and further, if the point at which the horizontal 
component or a parallel-to-floor component of the moment 
of a node floor reaction force of the B-th node becomes 
zero is defined as the node floor reaction force central 
point of the B-th node, 

the control device for a mobile body, comprising: 
a means for determining a desired node floor 
reaction force central point, which is the desired 
position of a node floor reaction force central point of 
each node, on the basis of at least one of a desired 
motion and a desired floor reaction force of the desired 
gait; 

a means for determining an actual node floor 
reaction force as the actual value of a node floor 
reaction force of each node from the detected or estimated 
actual floor reaction force of each ground contact 
portion; and 

a node operation controlling means that determines, 
on each of the C-th nodes, which is a node having a 
plurality of ground contact portions as descendant nodes, 
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by using, as a control amount, one of 
a difference (Mc_act-Mc_dmd) between an actual 
moment (Mc_act) , which is the moment caused by the actual 
node floor reaction force of the C-th node to act on a 
5 desired node floor reaction force central point of the C- 
th node, and a desired value (Mc_dmd) of a moment that 
should act on the desired node floor reaction force 
central point of the C-th node, 

a difference (Mc_f -Mc_dmd) between a moment (Mc_f ) , 
10 which is obtained by subtracting the moment caused by the 
actual node floor reaction force of each child node of the 
C-th node to act on a desired node floor reaction force 
central point of the child node from the actual moment 
(Mc_act) of the C-th node, and a desired value (Mc_dmd) of 
15 a moment that should act on the desired node floor 
reaction force central point of the C-th node, 

a value of the difference (AP) between the position 
of the point at which the horizontal component or the 
parallel-to-floor component of the moment of the actual 
20 node floor reaction force of the C-th node becomes zero 

and the position of the desired node floor reaction force 
central point of the C-th node, and 

a value of the difference (APf) between the position 
of the point at which the horizontal component or the 
25 parallel-to-floor component of the moment, which is 

obtained by subtracting the moment caused by the actual 
node floor reaction force of each child node of the C-th 
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node to act on the desired node floor reaction force 
central point of the child node from the moment of the 
actual node floor reaction force (Mc_act) of the C-th node, 
becomes zero and the position of the desired node floor 
reaction force central point of the C-th node, 

a correction amount of the desired relative heights 
of a plurality of ground contact portions belonging to the 
C-th node, for each C-th node, such that the control 
amount approximates zero on the basis of the control 
amount, and also determines, on the basis of a correction 
amount obtained by combining the determined correction 
amounts of all C-th nodes, a corrected desired motion 
obtained by adding at least a first correction of the 
desired relative heights of the plurality of ground 
contact portions belonging to each C-th node to a desired 
motion of the desired gait, then operates the joints such 
that the determined corrected desired motion is satisfied. 
6. A control device for a mobile body that comprises a 
desired gait determining means for determining a desired 
gait composed of a desired motion and a desired floor 
reaction force of a mobile body, such as a mobile robot 
having three or more ground contact portions connected 
through the intermediary of a plurality of joints such 
that mutual relative heights thereof can be manipulated, 
and a floor reaction force detecting means for detecting 
or estimating an actual floor reaction force acting on 
each of the ground contact portions, and controls the 
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operation of the mobile body to make a gait of the mobile 
body follow a desired gait, 

wherein the ground contact portions are classified 
into a tree structure such that each of the ground contact 
5 portions becomes a leaf node, and an intermediate node 
exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to each of B-th nodes, which is each node 
in the tree structure, if the B-th node is the leaf node, 

10 then a floor reaction force acting on a ground contact 

portion that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if the B-th node has 
child nodes, then the resultant force of the node floor 
reaction forces of all child nodes of the B-th node is 

15 defined as the node floor reaction force of the B-th node, 
and further, if the point at which the horizontal 
component or a parallel-to-floor component of the moment 
of the node floor reaction force of the A-th node becomes 
zero is defined as the node floor reaction force central 

20 point of the B-th node, 

the control device for a mobile body, comprising: 
relative to a predetermined C-th node that is an 
intermediate node having a plurality of ground contact 
portions as descendant nodes, 

25 a means for determining a desired node floor 

reaction force central point, which is the desired 
position of a node floor reaction force central point of 



at least the C-th node, on the basis of at least the 
desired gait; 

a means for determining an actual node floor 
reaction force as the actual value of a node floor 
reaction force of at least the C-th node from the detected 
or estimated actual floor reaction force of each ground 
contact portion; and 

a node operation controlling means that determines, 

by using, as a control amount, one of 

a difference (Mc_act-Mc_dmd) between an actual 
moment (Mc_act) , which is the moment caused by the actual 
node floor reaction force of the C-th node to act on a 
desired node floor reaction force central point of the C- 
th node, and a desired value (Mc_dmd) of a moment that 
should act on the desired node floor reaction force 
central point of the C-th node, 

a difference (Mc_f -Mc_dmd) between a moment (Mc_f ) , 
which is obtained by subtracting the moment caused by the 
actual node floor reaction force of each child node of the 
C-th node to act on a desired node floor reaction force 
central point of the child node from the actual moment 
(Mc_act) of the C-th node, and a desired value (Mc_dmd) of 
a moment that should act on the desired node floor 
reaction force central point of the C-th node, 

a value of the difference (AP) between the position 
of the point at which the horizontal component or the 
parallel-to-floor component of the moment of the actual 
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node floor reaction force of the C-th node becomes zero 
and the position of the desired node floor reaction force 
central point of the C-th node, and 

a value of the difference (APf) between the position 
5 of the point at which the horizontal component or the 
parallel-to-floor component of the moment, which is 
obtained by subtracting the moment caused by the actual 
node floor reaction force of each child node of the C-th 
node to act on the desired node floor reaction force 

10 central point of the child node from the moment of the 

actual node floor reaction force (Mc_act) of the C-th node, 
becomes zero and the position of the desired node floor 
reaction force central point of the C-th node, 

a corrected desired motion by adding at least a 

15 first correction of the desired relative heights of a 

plurality of ground contact portions belonging to the C-th 
node to the desired motion of the desired gait such that 
the control amount approximates zero on the basis of the 
control amount, and operates the joints such that the 

20 determined corrected desired motion is satisfied. 

7. The control device for a mobile body according to 
Claim 5, 

wherein a weight has been set on each node in the 
tree structure, and relative to a B-th node, which is each 
25 node in the tree structure, if the B-th node is the leaf 
node, then the height of a ground contact portion that is 
the leaf node is defined as the height of the B-th node, 
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and if the B-th node has child nodes, then a weighted mean 
value, which uses the weight, of the heights of all child 
nodes of the B-th node is defined as the height of the B- 
th node, and 

5 when the node operation controlling means determines 

the corrected desired motion for only one arbitrary node 
among C-th nodes by adding a first correction of the 
desired relative heights of the plurality of ground 
contact portions belonging to that one node to the desired 
10 motion, the desired height of that one node in the 

corrected desired motion is maintained at a desired height 
in the desired motion. 

8. The control device for a mobile body according to 
Claim 6, 

15 wherein a weight has been set on each node in the 

tree structure, and relative to a B-th node, which is each 
node in the tree structure, if the B-th node is the leaf 
node, then the height of a ground contact portion that is 
the leaf node is defined as the height of the B-th node, 

20 and if the B-th node has child nodes, then the weighted 

mean value, which uses said weight, of the heights of all 
child nodes of the B-th node is defined as the height of 
the B-th node, and 

when the node operation controlling means determines, 

25 only on the C-th node, the corrected desired motion by 

adding a first correction of the desired relative heights 
of a plurality of ground contact portions belonging to the 
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C-th node to the desired motion, the desired height of the 
C-th node in the corrected desired motion is maintained at 
the desired height in the desired motion. 

9. The control device for a mobile body according to 

5 Claim 7 or 8, wherein the means for determining a desired 
node floor reaction force central point determines the 
desired node floor reaction force central points and 
weights of the C-th node and each of the descendant nodes 
thereof such that the weighted mean value, which uses the 
10 weight, of the positions of the desired node floor 

reaction force central points of each child node of the C- 
th node will be the desired node floor reaction force 
central point of the C-th node. 

10. The control device for a mobile body according to 
15 Claim 5, wherein the node operation controlling means 

determines, for each of the C-th nodes, the correction 
amounts of the desired relative heights of the plurality 
of ground contact portions belonging to the C-th node on 
the basis of a movement amount of a desired node floor 

20 reaction force central point of each child node of the C- 
th node, the movment amount being obtained when the 
desired node floor reaction force central point of each 
child node of the C-th node is rotated about the desired 
node floor reaction force central point of the C-th node 

25 by the rotational amount determined on the basis of at 
least the control amount. 

11. The control device for a mobile body according to 
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Claim 6, wherein the node operation controlling means 
determines the corrected desired motion by adding a first 
correction of the desired relative heights of the 
plurality of ground contact portions belonging to the C-th 
5 node to the desired motion on the basis of the movement 
amount of the desired node floor reaction force central 
point of each child node of the C-th node, the movement 
amount being obtained when the desired node floor reaction 
force central point of each child node of the C-th node is 

10 rotated about the desired node floor reaction force 

central point of the C-th node by the rotational amount 
determined on the basis of at least the control amount. 
12. The control device for a mobile body according to 
Claim 7, wherein the node operation controlling means 

15 determines a corrected desired motion, which is obtained 
by adding a first correction of the desired relative 
heights of a plurality of ground contact portions 
belonging to the C-th node to the desired motion, by 
manipulating the mutual relative heights of the child 

20 nodes of the C-th node on the basis of the movement amount 
of the desired node floor reaction force central point of 
each child node of the C-th node, the movement amount 
being obtained when the desired node floor reaction force 
central point of each child node of the C-th node is 

25 rotated about the desired node floor reaction force 

central point of the C-th node by the rotational amount 
determined on the basis of at least the control amount. 
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13. The control device for a mobile body according to any 
one of Claims 3, 4, 7 and 8, wherein on each node having 
child nodes in the tree structure, the weights of all 
child nodes of each node are set such that the total sum 

5 of the weights of all the child nodes becomes one. 

14. The control device for a mobile body according to any 
one of Claims 3, 4, 7 and 8, further comprising a means 
for variably setting the weight of the each node, wherein 
if a leaf node corresponding to each ground contact 

10 portion not in contact with the ground is defined as a D- 
th node, then the means for setting weights sets the 
weight of each D-th node or the weight of at least one 
node of the ancestor nodes of the D-th node to zero. 

15. The control device for a mobile body according to any 
15 one of Claims 1, 2, 5 and 6, further comprising an actual 

posture inclination detecting means for detecting or 
estimating the actual posture inclination of a 
predetermined portion, such as the base body, of the 
mobile body, 

20 wherein, when determining the corrected desired 

motion, the node operation controlling means determines 
the corrected desired motion by further adding, to the 
desired motion, a correction of the desired relative 
heights of a plurality of ground contact portions 

25 belonging to the C-th node on the basis of a difference 
between the actual posture inclination and the desired 
posture inclination of the predetermined portion in a 
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desired motion of the desired gait such that the 
difference approximates zero. 

16. The control device for a mobile body according to 
Claim 5 or 6, further comprising an actual posture 
inclination detecting means for detecting or estimating 
the actual posture inclination of a predetermined portion, 
such as the base body, of the mobile body, 

wherein the node operation controlling means 
comprises a means for correcting at least either the 
desired value of the moment that should act on the desired 
node floor reaction force central point of the C-th node 
or the desired node floor reaction force central point of 
the C-th node on the basis of a posture inclination error, 
which is the difference between the actual posture 
inclination and the desired posture inclination of the 
predetermined portion in the desired motion, such that the 
posture inclination error approximates zero, and 
determines the control amount by using the desired value 
of a moment or the desired node floor reaction force 
central point, which have been corrected, in place of the 
desired value of a moment or a desired node floor reaction 
force central point before the correction. 

17. The control device for a mobile body according to 
Claim 5 or 6, each of the ground contact portions being 
connected to a base body of the mobile body through the 
intermediary of connecting mechanisms such that they are 
movable with respect to the base body, the control device 
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comprising : 

a desired node floor reaction force distributing 
means for determining, on each of E-th nodes, which is a 
node having child nodes in the tree structure, the 
5 translational force component of a desired node floor 
reaction force of each leaf node belonging to the E-th 
node on the basis of at least the desired floor reaction 
force of the desired gait such that the horizontal 
component or the parallel-to-floor component of a moment 

10 caused by a desired node floor reaction force, which is 

the desired value of the E-th node floor reaction force, 
to act on the desired node floor reaction force central 
point of the E-th node becomes zero, 

wherein the node operation controlling means 

15 comprises a means for estimating, on the basis of at least 
the translational force component of a desired node floor 
reaction force of each leaf node belonging to the C-th 
node, the amount of a deformation that occurs in a 
connecting mechanism between the base body and each ground 

20 contact portion belonging to the C-th node and in the 
ground contact portion when the translational force 
component of the desired node floor reaction force acts on 
each of the ground contact portion belonging to the C-th 
node, and when determining the corrected desired motion, 

25 the node operation controlling means determines the 

corrected desired motion by further adding, to the desired 
motion, a second correction of the desired height of each 



- 350 - 



of a plurality of ground contact portions belonging to the 
C-th node to cancel the estimated deformation amount. 
18. The control device for a mobile body according to any 
one of Claims 3, 4, 7 and 8, each of the ground contact 
5 portions being connected to a base body of the mobile body 
through the intermediary of connecting mechanisms such 
that they are movable with respect to the base body, the 
control device comprising: 

a desired node floor reaction force distributing 

10 means that determines, on each of E-th nodes, which is a 
node having a parent node in the tree structure, the 
translational force component of a desired node floor 
reaction force of the E-th node on the basis of at least 
the desired floor reaction force of the desired gait such 

15 that the translational force component of a desired node 

floor reaction force, which is the desired value of the E- 
th node floor reaction force, takes a value obtained by 
multiplying the translational force component of a desired 
node floor reaction force of the parent node of the E-th 

20 node by the weight of the E-th node, 

wherein the node operation controlling means 
comprises a means for estimating, on the basis of at least 
the translational force component of a desired node floor 
reaction force of each leaf node belonging to the C-th 

25 node, the amount of a deformation that occurs in a 

connecting mechanism between the base body and each ground 
contact portion belonging to the C-th node and in the 
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ground contact portion when the translational force 
component of the desired node floor reaction force acts on 
each of the ground contact portion belonging to the C-th 
node, and when determining the corrected desired motion, 
5 the node operation controlling means determines the 

corrected desired motion by further adding, to the desired 
motion, a second correction of the desired height of each 
of a plurality of ground contact portions belonging to the 
C-th node to cancel the estimated deformation amount. 

10 19. The control device for a mobile body according to 

Claim 5 or 6, each of the ground contact portions being 
connected to a base body of the mobile body through the 
intermediary of connecting mechanisms such that they are 
movable with respect to the base body, the control device 

15 further comprising: 

an actual posture inclination detecting means for 
detecting or estimating the actual posture inclination of 
a predetermined portion, such as the base body, of the 
mobile body; 

20 a means for correcting the desired node floor 

reaction force central point of at least the C-th node on 
the basis of a posture inclination error, which is the 
difference between the actual posture inclination and the 
desired posture inclination of the predetermined portion 

25 in the desired motion, such that the posture inclination 
error approximates zero; and 

a desired node floor reaction force distributing 



- 352 - 



means that determines at least the translat ional force 
component of a desired node floor reaction force, which is 
the desired value of the node floor reaction force of each 
descendant node of the C-th node, out of the desired node 
5 floor reaction force, which is the desired value of the 

node floor reaction force of each node, on the basis of at 
least the desired floor reaction force of the desired gait 
such that the horizontal component or the parallel-to- 
floor component of the moment of a desired node floor 

10 reaction force acting on the corrected desired node floor 

reaction force central point of the C-th node becomes zero, 

wherein the node operation controlling means 
comprises a means for estimating, on the basis of at least 
the translational force component of a desired node floor 

15 reaction force of each leaf node belonging to the C-th 
node, the amount of a deformation that occurs in a 
connecting mechanism between the base body and each ground 
contact portion belonging to the C-th node and in the 
ground contact portion when the translational force 

20 component of the desired node floor reaction force acts on 
each of the ground contact portion belonging to the C-th 
node, and when determining the corrected desired motion, 
the node operation controlling means determines the 
control amount by using the corrected desired node floor 

25 reaction force central point of the C-th node in place of 
the desired node floor reaction force central point before 
the correction and also determines the corrected desired 
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motion by further adding, to the desired motion, a second 
correction of the desired height of each of a plurality of 
ground contact portions belonging to the C-th node to 
cancel the estimated deformation amount. 
5 20. The control device for a mobile body according to 

Claim 5 or 6, each of the ground contact portions being 
connected to a base body of the mobile body through the 
intermediary of connecting mechanisms such that they are 
movable with respect to the base body, the control device 
10 comprising: 

an actual posture inclination detecting means for 
detecting or estimating an actual posture inclination of a 
predetermined portion, such as the base body, of the 
mobile body; 

15 a means for determining the desired value of a 

moment that should act on the desired floor reaction force 
central point of at least the C-th node on the basis of a 
posture inclination error, which is the difference between 
the actual posture inclination and the desired posture 

20 inclination of the predetermined portion in the desired 
motion, such that the posture inclination error 
approximates zero; and 

a desired node floor reaction force distributing 
means that determines at least the translat ional force 

25 component of a desired node floor reaction force, which is 
the desired value of a node floor reaction force of each 
descendant node of the C-th node, out of the desired node 
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floor reaction force, which is the desired value of a node 
floor reaction force of each node, on the basis of at 
least a floor reaction force of the desired gait such that 
the moment of a desired node floor reaction force acting 
5 on the desired node floor reaction force central point of 
the C-th node becomes the determined desired value, 

wherein the node operation controlling means 
comprises a means for estimating, on the basis of at least 
the translational force component of a desired node floor 

10 reaction force of each leaf node belonging to the C-th 

node, the amount of a deformation that occurs in a 
connecting mechanism between the base body and each ground 
contact portion belonging to the C-th node and in the 
ground contact portion when the translational force 

15 component of the desired node floor reaction force acts on 
each ground contact portion belonging to the C-th node, 
and when determining the corrected desired motion, the 
node operation controlling means determines the control 
amount by using the determined desired value of the moment 

20 of the C-th node and also determines the corrected desired 
motion by further adding, to the desired motion, a second 
correction of the desired height of each of a plurality of 
ground contact portions belonging to the C-th node to 
cancel the estimated deformation amount. 

25 21. The control device for a mobile body according to any 
one of Claims 3, 4, 7, and 8, each of the ground contact 
portions being connected to a base body of the mobile body 
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through the intermediary of connecting mechanisms such 
that they are movable with respect to the base body, the 
control device further comprising: 

an actual posture inclination detecting means for 
5 detecting or estimating the actual posture inclination of 
a predetermined portion, such as the base body, of the 
mobile body; 

a means for correcting the weight of each descendant 
node of at least the C-th node on the basis of the posture 

10 inclination error, which is the difference between the 

actual posture inclination and the desired posture of the 
predetermined portion in the desired motion, such that a 
posture inclination error approximates zero; and 

a desired node floor reaction force distributing 

15 means that determines at least the translat ional force 

component of a desired node floor reaction force, which is 
the desired value of a node floor reaction force of each 
descendant node of the C-th node, out of the desired node 
floor reaction force, which is the desired value of the 

20 node floor reaction force of each node, on the basis of at 
least the desired floor reaction force of the desired gait, 
so as to take a value obtained by multiplying the 
translational force component of a desired node floor 
reaction force of a parent node of each descendant node by 

25 the corrected weight of the descendant node, 

wherein the node operation controlling means 
comprises a means for estimating, on the basis of at least 
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the translational force component of a desired node floor 
reaction force of each leaf node belonging to the C-th 
node, the amount of a deformation that occurs in a 
connecting mechanism between the base body and each ground 
5 contact portion belonging to the C-th node and in the 
ground contact portion when the translational force 
component of the desired node floor reaction force acts on 
each ground contact portion belonging to the C-th node, 
and when determining the corrected desired motion, the 

10 node operation controlling means determines the corrected 
desired motion by further adding, to the desired motion, a 
second correction of the desired height of each of a 
plurality of ground contact portions belonging to the C-th 
node to cancel the estimated deformation amount. 

15 22. The control device for a mobile body according to 

Claim 1 or 5, wherein each of the ground contact portions 
is connected to a base body of the mobile body such that 
they are movable with respect to the base body, and 

when determining the corrected desired motion, the 

20 node operation controlling means determines the corrected 
desired motion by further adding, to the desired motion, a 
correction of a desired posture of the base body to 
restrain slippages, such as twists, of each of the ground 
contact portions belonging to the C-th node on a floor 

25 surface. 

23. The control device for a mobile body according to 
Claim 2 or 6, wherein each of the ground contact portions 
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is connected to a base body of the mobile body such that 
they are movable with respect to the base body, and 

when determining the corrected desired motion, the 
node operation controlling means determines the corrected 
5 desired motion by further adding, to the desired motion, a 
correction of a desired posture of the base body to 
restrain slippages, such as twists, of each of the ground 
contact portions belonging to the C-th node on a floor 
surface . 

10 24. The control device for a mobile body according to 

Claim 22, wherein the node operation controlling means 
determines the corrected desired motion such that the 
direction of the segment that connects the desired overall 
floor reaction force central point of the mobile body, 

15 which depends on a desired floor reaction force of the 
desired gait, and the overall center-of -gravity of the 
mobile body or a predetermined representative point of the 
base body of the mobile body in the corrected desired 
motion is substantially identical to the direction of the 

20 segment in the desired gait. 

25. The control device for a mobile body according to 
Claim 23, wherein the node operation controlling means 
determines the corrected desired motion such that the 
direction of the segment that connects the desired overall 

25 floor reaction force central point of the mobile body, 
which depends on a desired floor reaction force of the 
desired gait, and the overall center-of -gravity of the 
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mobile body or a predetermined representative point of the 
base body of the mobile body in the corrected desired 
motion is substantially identical to the direction of the 
segment in the desired gait. 
5 26. The control device for a mobile body according to 
Claim 22, wherein the node operation controlling means 
determines the corrected desired motion such that the 
horizontal position of the overall center-of -gravity of 
the mobile body or the horizontal position of a 
10 predetermined representative point of the base body of the 
mobile body in the corrected desired motion is 
substantially identical to the horizontal position in the 
desired motion. 

27. The control device for a mobile body according to 
15 Claim 23, wherein the node operation controlling means 

determines the corrected desired motion such that the 
horizontal position of the overall center-of -gravity of 
the mobile body or the horizontal position of a 
predetermined representative point of the base body of the 
20 mobile body in the corrected desired motion is 

substantially identical to the horizontal position in the 
desired motion. 

28. The control device for a mobile body according to 
Claim 22, wherein the mobile body is a robot comprising a 

25 plurality of link mechanisms extended from its base body, 
and at least one link mechanism among the plurality of 
link mechanisms is provided with a joint at least in an 
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intermediate portion thereof between a distal end thereof 
and an end thereof adjacent to the base body, and the 
intermediate portion is the ground contact portion. 

29. The control device for a mobile body according to 

5 Claim 23, wherein the mobile body is a robot equipped with 
a plurality of link mechanisms extended from its base body, 
and at least one link mechanism among the plurality of 
link mechanisms is provided with a joint at least in an 
intermediate portion between its distal end and its end 
10 adjacent to the base body, and the intermediate portion is 

a ground contact portion belonging to the C-th node. 

30. The control device for a mobile body according to 
Claim 28, wherein the intermediate portion is provided 
with an elastic member that resiliently deforms when 

15 coming into contact with the ground. 

31. The control device for a mobile body according to 
Claim 29, wherein the intermediate portion is provided 
with an elastic member that resiliently deforms when 
coming into contact with the ground. 

20 32. The control device for a mobile body according to 

Claim 22, wherein the mobile body comprises a plurality of 
link mechanisms extended from its base body, each of which 
has one or more joints, at least one link mechanism among 
the link mechanisms and the base body are provided with 

25 ground contact portions, and ground contact portions that 
belong to at least one of the C-th nodes include at least 
a ground contact portion of the base body and ground 
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contact portions of one or more link mechanisms among the 
plurality of link mechanisms. 

33. The control device for a mobile body according to 
Claim 23, wherein the mobile body is provided with a 

5 plurality of link mechanisms extended from its base body, 
each of which has one or more joints, at least one link 
mechanism among the link mechanisms and the base body are 
provided with ground contact portions, and ground contact 
portions that belong to the C-th node include at least a 
10 ground contact portion of the base body and ground contact 
portions of one or more link mechanisms among the 
plurality of link mechanisms. 

34. The control device for a mobile body according to 
Claim 32, wherein a ground contact portion of the base 

15 body is provided with an elastic member that resiliently 
deforms when coming into contact with the ground. 

35. The control device for a mobile body according to 
Claim 33, wherein a ground contact portion of the base 
body is provided with an elastic member that resiliently 

20 deforms when coming into contact with the ground. 

36. The control device for a mobile body according to any 
one of Claims 1, 2, 5, and 6, wherein a weight has been 
set on each node in the tree structure, and 

if processing in which, when a predetermined type of 
25 state amount, such as a height or a floor reaction force, 
is associated with each leaf node in the tree structure, 
the state amount of each node having child nodes is 
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defined as a weighted mean value, which uses the weight, 
of the state amounts of all child nodes of the node, the 
value obtained by subtracting a state amount of a parent 
node of the node from the state amount of the node is 
5 determined as a node relative state amount of the node on 
each node except a root node, and zero is determined as a 
relative state amount of the root node, is defined as the 
processing for hierarchically relativizing the 
predetermined type of state amount on each node, 

10 if a node relative floor reaction force 

Fn_rel (n=l , 2 , . . . ) hierarchically relativized on each node 
is determined on the basis of a floor reaction force 
Fn (n=l, 2, ...) acting on each of the ground contact portions, 
which are the leaf nodes, and when a vector 

15 (Fal_rel, Fa2_rel, Far_rel) having, as its elements, the 

node relative floor reaction forces of all child nodes aj 
( j =1 , 2 , . .. , r . r denotes the total number of the child nodes 
of an n-th node) of an n-th node, which is an arbitrary 
node having child nodes, is represented by a linear 

20 linkage of a plurality of predetermined mutually 

independent vectors R(j) ( j = 1 , 2 , . . . , r- 1 ) that are all 
orthogonal to a vector (Wal , Wa2 , . . . , War ) having the weights 
of all child nodes of the n-th node as its elements, a 
vector having a coefficient of the linear linkage as its 

25 element is defined as a node expansion floor reaction 
force moment Mn_exp of the n-th node, and 

if a node relative height Zn_rel (n=l , 2 , . . . ) 
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hierarchically relativized on each node is determined on 
the basis of a height Zn (n=l,2,...) of each of the ground 
contact portions, which are the leaf nodes, and when a 
vector (Zal_rel, Za2_rel, Zar_rel) having the node 
relative heights of all child nodes aj ( j=l, 2, r . r 
denotes the total number of the child nodes of an n-th 
node) of the n-th node as its elements is expressed by a 
linear linkage of the plurality of the predetermined 
mutually independent vectors R(j) ( j=l, 2, r-1) , a vector 
having a coefficient of the linear linkage as its element 
is defined as a node expansion inclination angle 0n of the 
n-th node, 

then, the node operation controlling means 
determines the corrected desired motion by adding, to the 
desired motion, a first correction of the desired relative 
heights of a plurality of ground contact portions 
belonging to the C-th node by using at least the node 
expansion floor reaction force moment Mn_exp or the node 
expansion inclination angle 9n of the C-th node. 
37. The control device for a mobile body according to 
Claim 36, further comprising: a means for determining a 
desired floor reaction force that should act on each 
ground contact portion belonging to at least the C-th node 
on the basis of at least the desired floor reaction force 
of the desired gait, 

wherein the node operation controlling means 
comprises a means for determining a desired node expansion 



moment, which is a desired value of the node expansion 
moment of the C-th node, on the basis of the desired floor 
reaction force of each ground contact portion belonging to 
the C-th node, a means for determining an actual node 
expansion moment, which is an actual value of the node 
expansion moment of the C-th node on the basis of an 
actual floor reaction force of each ground contact portion 
belonging to the C-th node, and a means for determining a 
manipulated variable of the node expansion inclination 
angle of the C-th node on the basis of the actual node 
expansion moment and the desired node expansion moment, 
and determines the corrected desired motion by adding, to 
the desired motion, a first correction of the desired 
relative heights of a plurality of ground contact portions 
belonging to the C-th node on the basis of the determined 
manipulated variable of the node expansion inclination 
angle . 

38. The control device for a mobile body according to any 
one of Claims 1, 2, 5, and 6, further comprising: a floor 
configuration estimating means for estimating a parameter 
that specifies the relative heights of the ground contact 
surfaces of a plurality of ground contact portions 
belonging to at least the C-th node as the floor 
configuration parameter that represents a floor 
configuration, 

wherein the node operation controlling means 
determines the corrected desired motion by further adding 
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a third correction of the desired relative heights of a 
plurality of the ground contact portions belonging to the 
C-th node on the basis of an estimated value of the floor 
configuration parameter when determining the corrected 
5 desired motion. 

39. The control device for a mobile body according to 
Claim 38, further comprising a means for determining an 
actual node floor reaction force, which is the actual 
value of a node floor reaction force of each child node of 

10 at least the C-th node, from an actual floor reaction 

force of each ground contact portion belonging to the C-th 
node, 

wherein the floor configuration estimating means 
performs estimation while sequentially updating the floor 

15 configuration parameter on the basis of a past value of an 
estimated value of the floor configuration parameter, a 
difference between the corrected desired motion and the 
desired motion, the corrected motion, at least either a 
detected value or an estimated value of an actual joint 

20 displacement, which is a displacement amount of each joint 
of the mobile body, the actual posture inclination, and a 
relative relationship among the actual node floor reaction 
forces of each child node of at least the C-th node. 

40. The control device for a mobile body according to 
25 Claim 38, each of the ground contact portions being 

connected to the base body of the mobile body through the 
intermediary of connecting mechanisms such that they are 



movable with respect to the base body, the control device 
comprising : 

a deformation amount detecting means for detecting 
or estimating the amounts of deformations that occurs in 
the connecting mechanisms between the base body and each 
of the ground contact portions belonging to the C-th node 
and in the ground contact portions, 

wherein the floor configuration estimating means 
performs estimation while sequentially updating the floor 
configuration parameter on the basis of a past value of an 
estimated value of the floor configuration parameter, a 
difference between the corrected desired motion and the 
desired motion, the corrected motion, at least either a 
detected value or an estimated value of an actual joint 
displacement, which is a displacement amount of each joint 
of the mobile body, the actual posture inclination, and 
the deformation amounts associated with each of the ground 
contact portions belonging to at least the C-th node. 

41. The control device for a mobile body according to 
Claim 40, wherein the deformation amount detecting means 
estimates the deformation amounts on the basis of the 
actual floor reaction forces of each of the ground contact 
portions . 

42. The control device for a mobile body according to 
Claim 38, wherein a weight of each node in the tree 
structure has been set, and relative to a B-th node, which 
is each node in the tree structure, if the B-th node is 
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the leaf node, then the height of the ground contact 
surface of a ground contact portion that is the leaf node 
is defined as the height of the ground contact surface of 
the B-th node and if the B-th node has child nodes, then a 
5 weighted mean value, which uses the weight, of the heights 
of the ground contact surfaces of all child nodes of the 
B-th node is defined as the height of the ground contact 
surface of the B-th node, 

then the floor configuration parameter estimated by 
10 the floor configuration estimating means is a parameter 

that specifies the relative relationship among the heights 
of the ground contact surfaces of a plurality of child 
nodes of the C-th node. 

43. The control device for a mobile body according to 

15 Claim 42, wherein, when at least one of the child nodes of 
the C-th node is likely to float, the floor configuration 
estimating means estimates the floor configuration 
parameter that specifies the relative relationship among 
the heights of the ground contact surfaces of the 

20 plurality of child nodes, while maintaining the relative 
height of the ground contact surface of that child node, 
which is likely to float, at a fixed value. 

44. The control device for a mobile body according to 
Claim 38, wherein the floor configuration estimating means 

25 estimates the floor configuration parameter by using a 
low-pass filter so as to alleviate fluctuations in the 
floor configuration parameter. 
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45. The control device for a mobile body according to 
Claim 38, wherein a weight has been set on each node in 
the tree structure, and 

if processing in which, when a predetermined type of 
state amount, such as a height or a floor reaction force, 
is associated with each leaf node in the tree structure, 
the state amount of each node having child nodes takes a 
weighted mean value, which uses the weight, of the state 
amounts of all child nodes of the node, a value obtained 
by subtracting a state amount of a parent node of each 
node from the state amount of the node is determined as a 
node relative state amount of the node on each node except 
a root node, and zero is determined as a relative state 
amount of the root node, is defined as the processing for 
hierarchically relativizing the predetermined type of 
state amount on each node, 

if a node relative floor reaction force 
Fn_rel (n=l, 2, ...) hierarchically relativized on each node 
is determined on the basis of a floor reaction force 
Fn (n=l, 2, ...) acting on each of the ground contact portions, 
which are the leaf nodes, and if a vector 

(Fal_rel, Fa2_rel, Far_rel) having, as its elements, the 
node relative floor reaction forces of all child nodes aj 

( j =1 , 2 , . .. , r . r denotes the total number of the child nodes 
of an n-th node) of an n-th node, which is an arbitrary 
node having child nodes, is represented by a linear 
linkage of a plurality of predetermined mutually 
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independent vectors R(j) ( j=l, 2, r-1) that are all 
orthogonal to a vector (Wal , Wa2 , . .. , War ) having the weights 
of all child nodes of the n-th node as its elements, then 
a vector having a coefficient of the linear linkage as its 
5 element is defined as a node expansion floor reaction 
force moment Mn_exp of the n-th node, and 

if a node relative height Zn_rel (n=l , 2 , . . . ) 
hierarchically relativized on each node is determined on 
the basis of a height Zn (n=l, 2, ...) of the ground contact 
10 surface of each of the ground contact portions, which are 

the leaf nodes, and if a vector (Zal_rel, 

Za2_rel, Zar_rel) having the node relative heights of 
all child nodes aj ( j = 1 , 2 , . . . , r . r denotes the total number 
of the child nodes of an n-th node) of the n-th node as 

15 its elements is expressed by a linear linkage of the 
plurality of the predetermined mutually independent 
vectors R(j) ( j=l, 2, r-1) , then a vector having a 
coefficient of the linear linkage as its element is 
defined as a node expansion inclination angle 9n of the n- 

20 th node, and 

the floor configuration estimating means estimates 
the floor configuration parameter by using at least the 
node expansion floor reaction force moment Mn_exp or the 
node expansion inclination angle 0n of the C-th node. 

25 46. The control device for a mobile body according to 

Claim 45, wherein, relative to a B-th node, which is each 
node in the tree structure, if the B-th node is the leaf 
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node, then the height of the ground contact surface of the 
ground contact portion that is the leaf node is defined as 
the height of the ground contact surface of the B-th node, 
and if the B-th node has child nodes, then a weighted mean 
5 value, which uses the weight, of the heights of the ground 
contact surfaces of all child nodes of the B-th node, is 
defined as the height of the ground contact surface of the 
B-th node, and 

the floor configuration parameter includes a 

10 parameter that uses the node expansion inclination angle 
to indicate the relative height of the ground contact 
surface of each child node of the C-th node. 
47. The control device for a mobile body according to 
Claim 45, further comprising a means for determining a 

15 desired floor reaction force that should act on each 

ground contact portion belonging to at least the C-th node 
on the basis of at least the desired floor reaction force 
of the desired gait, 

wherein the node operation controlling means 

20 comprises a means for determining a desired node expansion 
moment, which is a desired value of the node expansion 
moment of the C-th node, on the basis of the desired floor 
reaction force of each ground contact portion belonging to 
the C-th node, a means for determining an actual node 

25 expansion moment, which is the actual value of the node 
expansion moment of the C-th node on the basis of the 
actual floor reaction force of each ground contact portion 
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belonging to the C-th node, and a means for determining a 
manipulated variable of the node expansion inclination 
angle of the C-th node on the basis of the actual node 
expansion moment and the desired node expansion moment, 
and determines the corrected desired motion by adding, to 
the desired motion, a first correction of the desired 
relative heights of a plurality of ground contact portions 
belonging to the C-th node on the basis of the determined 
manipulated variable of the node expansion inclination 
angle . 



